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DETERMINE MASS POINT POSITIONS AND BODY POSTURE OF 1ST DISPLACEMENT DIMENSION CORREQING 
MODEL ON THE BASIS OF INSTANTANEOUS VALUES OF SIMPLIFIED MODEL GAIT AT CURRENT TIME t. 



S300 



DETERMINE INITIAL CANDIDATES (Pb22_s, 6 b22_s) OF 2ND PROVISIONAL CORREQED 
BODY POSmON/POSTURE ACCORDING TO THE FOLLOWING EXPRESSIONS ON THE BASIS 
OF 2ND PROVISIONAL CORREQED BODY POSITION Pb22_p AND DESIRED BODY 
POSITION Pb_p AT LAST TIME t- At, AND DESIRED BODY POSITION Pb AND DESIRED 
BODY POSTURE d b AT CURRENT TIME t. 

Pb22_s = Pb + (Pb22 _p-Pb _p) 

db22 s= db 



S302 



S306 



DETERMINE MASS POINT POSITIONS OF 2ND DISPLACEMENT DIMENSION CORRECTING MODEL ON 
THE BASIS OF CURRENT CANDIDATES (Pb22_s, 6 b22_$) AND DESIRED POSITIONS/POSTURES 
OF BOTH FEET AT CURRENT TIME t. 



S304 




DETERMINE ANGULAR MOMENTUM PRODUQ ERROR L_err BETWEEN 1ST DISPLACEMENT 

DIMENSION CORRECTING MODEL AND 2ND DISPUCEMENT DIMENSION CORREQING MODEL 



S308 



S310 yes 



IS L err WITHIN PERMISSIBLE RANGE? 



LEAVE REPETITION LOOP. 



S312 



S314 



DETERMINE A PLURALITY OF CANDIDATES (Pb22_s+ A Pb22x, 6 b22_s) AND 
(Pb22_s+ A Pb22z, 6 b22_s) NEAR {Pb22_s, 0 b22_s), THEN USE THEM AS 2ND PROVISIONAL 
CORREQED BODY POSITION/POSTURE aNDIDATES TO DETERMINE ANGULAR MOMENTUM PRODUQ 
ERROR AS DESCRIBED ABOVE. 



BASED ON ANGULAR MOMENTUM PRODUQ ERROR ASSOCIATED WITH (Pb22_s, 9 b22_s) 
AND CANDIDATES IN THE VIQNITY THEREOF, DETERMINE NEW 2ND PROVISIONAL CORRECTED 
BODY POSITION/POSTURE CANDIDATES (Pb22_s, 6 b22_s) SO AS TO APPROXIMATE 
THE ERROR TO ZERO. HOWEVER, 0 b22_s IS NOT CHANGED. 



531 6 



SUBSTITUTE CURRENT (Pb22_s, 0 b22_s) INTO 2ND PROVISIONAL CORRECTED BODY 

POSITION/POSTURE (Pb22, d b22) AT CURRENT TIME t. 



S318 



C RETURN ^ 
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S600 

OETERMiNE AAASS POINT POSITIONS AND BODY POSTURE OF 1ST DISPUCEMENT DIMENSION CORREQING 
MODEL ON THE BASIS OF INSTANTANEOUS VALUES OF SIMPLIFIED MODEL GAIT AT CURRENT TIME t. 



DETERMINE INITIAL CANDIDATES (Pb22_s, 6 b22_s) OF 2ND PROVISIONAL CORREQED BODY 
POSITION/POSTURE ACCORDING TO THE FOLLOWING EXPRESSIONS ON THE BASIS OF 2ND 
PROVISIONAL CORREQED BODY POSITION Pb22_p AND DESIRED BODY POSITION Pb_p AT 
LAST TIME t- A t, AND DESIRED BODY POSITION Pb, DESIRED BODY POSTURE 6 b, 
1 ST PROVISIONAL CORREQED BODY POSTURE 6 b21 AND WEIGHTS w1 , w2 AT CURRENT TIME t. 
Pb22_s = Pb + (Pb22_p-Pb_p) 
dhll s=wl * 0b21 +w2 * 0b 



S602 



S604 




DETERMINE MASS POINT POSITIONS OF 2ND DISPLACEMENT DIMENSION CORRECTING 
MODEL ON THE BASIS OF CURRENT CANDIDATES (Pb22_s, 6 b22_s) AND DESIRED 
POSITIONS/POSTURES OF BOTH FEET AT CURRENT TIME t. 



S606 



DETERMINE ANGULAR MOMENTUM PRODUQ ERROR L_err BEIWEEN 1ST DISPLACEMENT 
DIMENSION CORREQING MODEL AND 2ND DISPLACEMENT DIMENSION CORREQING MODEL 



S608 



S610 yes 



IS L err WITHIN PERMISSIBLE RANGE? 




LEAVE REPETITION LOOP. 
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S614 



DETERMINE A PLURALITY OF CANDIDATES (Pb22_s+ A Pb22x, 6 b22_s) AND 
(Pb22_s+ A Pb22z, 9 b22_s) NEAR (Pb22_s, 6 b22_s), THEN USE THEM AS 2ND PROVISIONAL 
CORREQED BODY POSITION/POSTURE CANDIDATES TO DETERMINE ANGULAR MOMENTUM PRODUQ 
ERROR AS DESCRIBED ABOVE. 



BASED ON ANGULAR MOMENTUM PRODUQ ERROR ASSOCIATED WITH (Pb22_s, 6 b22_s) AND 
CANDIDATES IN THE VIQNITY THEREOF, DETERMINE NEW 2ND PROVISIONAL CORRECTED BODY 
POSITION/POSTURE CANDIDATES (Pb22_s, 6 b22_s) SO AS TO APPROXIMATE THE ERROR TO ZERO. 
HOWEVER, e b22_s IS NOT CHANGED. 



S616 



SUBSTITUTE CURRENT (Pb22_s, 9 b22_s) INTO 2ND PROVISIONAL CORREQED BODY 
POSITION/POSTURE (Pb22, 9 b22) AT CURRENT TIME t. 



S618 



C RETURN ^ 
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DETERMINE MASS POINT POSITIONS AND BODY POSTURE OF 1ST DISPIACEMENT DIMENSION CORREOING 
MODEL ON THE BASIS OF INSTANTANEOUS VALUES OF SIMPUFIED MODEL GAIT AT CURRENT TIME t. 



S300 



DETERMINE INITIAL CANDIDATES {Pb22_s, 6 b22_$) OF 2ND PROVISIONAL CORRECTED 
BODY POSmOM/POSTURE ACCORDING TO THE FOLLOWING EXPRESSIONS ON THE BASIS 
OF 2ND PROVISIONAL CORRECTED BODY POSITION Pb22j> AND DESIRED BODY 
POSITION Pb_p AT LAST TIME t- A t, AND DESIRED BODY POSITION Pb AND DESIRED 
BODY POSTURE d b AT CURRENT TIME t. 
Pb22_s = Pb + (Pb22 j-Pb _p) 
db22 s= eh 



S302 



S306 



S304 




DETERMINE MASS POINT POSITIONS OF 2ND DISPLACEMENT DIMENSION CORRECTING MODEL ON 
THE BASIS OF CURRENT CANDIDATES (Pb22_s, 0 b22_s) AND DESIRED POSITIONS/POSTURES 
OF BOTH FEET AT CURRENT TIME I. 



DETERMINE ANGULAR MOMENTUM PRODUQ ERROR L_err BETWEEN 1ST DISPIACEMENT 
DIMENSION CORRECHNG MODEL AND 2ND DISPLACEMENT DIMENSION CORRECTING MODEL 



S3Q8 



S310 yes 



ISL err WITHIN PERMISSIBLE RANGE? 



LEAVE REPETITION LOOP. 



S312 



S314 



DETERMINE A PLURALITY OF aNDIDATES(Pb22_$+ A Pb22x, 0b22_s)AND 
(®L^ A Pb22z, e b22_s) NEAR (Pb22_s, 6 b22_s), THEN USE THEM AS 2ND PROVISIONAL 
CORRECTED BODY POSITION/POSTURE CANDIDATES TO DETERMINE ANGUIAR MOMENTUM PRODUCT 
ERROR AS DESCRIBED ABOVE. 



BASED ON ANGUIAR MOMENTUM PRODUCT ERROR ASSOQATED WITH (Pb22_s, 6 b22_s) 
AND CANDIDATES IN THE VIQNITY THEREOF, DETERMINE NEW 2ND PROVISIONAL CORRECTED 
BODY POSmON/POSTURE CANDIDATES {Pb22_s, Q b22_s) SO AS TO APPROXIMATE 
THE ERROR TO ZERO. HOWEVER, 6 b22_s IS NOT CHANGED. 



S316 



SUBSTITUTE CURRENT {Pb22_s, 6 b22_s) INTO 2ND PROVISIONAL CORRECTED BODY 
POSITION/POSTURE (Pb22, 0 b22) AT CURRENT TIME t. 



S318 



C RETURN ^ 
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S600 



DETERMINE MASS POINT POSITIONS AND BODY POSTURE OF 1ST DISPUCEMENT DIMENSION CORREOING 
MODEL ON THE BASIS OF INSTANTANEOUS VALUES OF SIMPUFIED MODEL GAIT AT CURRENT TIME t. 



DETERMINE INITIAL CANDIDATES (Pb22_s, 6 b22_s) OF 2ND PROVISIONAL CORRECTED BODY 

POSITION/POSTURE ACCORDING TO THE FOLLOWING EXPRESSIONS ON THE BASIS OF 2ND 

PROVISIONAL CORREQED BODY POSITION Pb22_p AND DESIRED BODY POSITION Pb_p AT 

LAST TIME t- A f, AND DESIRED BODY POSITION Pb, DESIRED BODY POSTURE 6 b, 

1 ST PROVISIONAL CORRECTED BODY POSTURE 6 b21 AND WEIGHTS w1 , w2 AT CURRENT TIME t. 

Pb22_s = Pb + (Pb22_p-Pb_p) 

eb22 s=wl * 0b21 +w2 * 0b 



S602 



S604 



oo 



DETERMINE MASS POINT POSITIONS OF 2ND DISPLACEMENT DIMENSION CORRECHNG 
MODEL ON THE BASIS OF CURRENT CANDIDATES (Pb22_$, 6 b22_s) AND DESIRED 
POSmONS/POSTURES OF BOTH FEET AT CURRENT TIME t. 



S606 



DETERMINE ANGUUR MOMENTUM PRODUG ERROR L.err BETWEEN 1ST DISPIACEMENT 
DIMENSION CORREOING MODEL AND 2ND DISPIACEMENT DIMENSION CORRECHNG MODEL 



S608 



S610 yes 



IS L err WITHIN PERMISSIBLE RANGE? 




LEAVE REPETITION LOOP. 



S612 



S614 



DETERMINE A PLURALITY OF CANDIDATES (Pb22_s+ A Pb22x, 6 b22_s) AND 
l(®_s+APb22z, 0 b22_$) NEAR (Pb22_s, 0 b22_s), THEN USE THEM AS 2ND PROVISIONAL 
CORRECTED BODY POSITION/POSTURE CANDIDATES TO DETERMINE ANGULAR MOMENTUM PRODUQ 
ERROR AS DESCRIBED ABOVE. 



BASED ON ANGULAR MOMENTUM PRODUQ ERROR ASSOCIATED WITH (Pb22_s, 0 b22_s) AND 
CANDIDATES IN THE VIQNITY THEREOF, DETERMINE NEW 2ND PROVISIONAL CORRECTED BODY 
POSITION/POSTURE ttNDIDATES {Pb22_$, 0 b22_s) SO AS TO APPROXIMATE THE ERROR TO ZERO. 
HOWEVER, e b22_s IS NOT CHANGED. 



S616 



SUBSTITUTE CURRENT (Pb22_s, 0 b22_s) INTO 2ND PROVISIONAL CORRECTED BODY 
POSITION/POSTURE (Pb22, 0 b22) AT CURRENT TIME t. 



S618 



C RETURN ^ 



